#include "LINEFOLLOW.h"
#include "debug_frmwrk.h"
#include <stdlib.h>
#include <stdio.h>

#define DEBUG 1

void printSensors(SensorVals* v);

void main(void){
  uint32_t j = 10000000;
  debug_frmwrk_init();
  _DBG_("DYNAMIC ENTRY!");
  LINE_SerialInit(); 
  LINE_AutoCalibrate();
  while(j--);
  LINE_StartFollow(&CFG);
  // LINE_Search_Clkw();
  //  LINE_Search_CClkw();
}


#if DEBUG
void printSensors(SensorVals* v){
  //  debug_frmwrk_init();
   
  _DBG_("PCO: ");
  _DBH16(v -> PC0);
  _DBG_("\n");
  _DBG_("PC1: ");
  _DBH16(v -> PC1);
  _DBG_("\n");
  _DBG_("PC2: ");
  _DBH16(v -> PC2);
  _DBG_("\n");
  _DBG_("PC3: ");
  _DBH16(v -> PC3);
  _DBG_("\n");
  _DBG_("PC4: ");
  _DBH16(v -> PC4);
  _DBG_("\n");
}
#endif
